#!/usr/bin/env python3

import rospy
from DrEmpower_can.msg import enable_angle_speed_torque_state
# import DrEmpower as dr

def callback(data):
    import DrEmpower as dr
    dr.enable_angle_speed_torque_state(id_num=data.id_num)
    rospy.loginfo("enable_angle_speed_torque_state_node")


def listener():
    rospy.init_node("enable_angle_speed_torque_state", anonymous=True)
    rospy.Subscriber("enable_angle_speed_torque_state", enable_angle_speed_torque_state, callback)
    rospy.spin()


if __name__ == '__main__':
    listener()

